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METHOD AND SYSTEM FOR DETERMINING THE POSITION OF AN 

OBJECT 

FIELD OF THE INVENTION 

[0001] The invention relates to a system and method for determining the position of an 
object using a frequency based sensor system (e.g., radar, sonar, global positioning 
satellites (GPS), cellular telephony, etc.). 

BACKGROUND OF THE INVENTION 

[0002] Accurately determining the position of moving objects, such as aircraft, missiles, 
land-vehicles, watercraft, and electronic devices (e.g., mobile telephones) has been a 
challenge for sometime. There have been many methods developed, including radar, 
sonar, GPS and other frequency based techniques. 

[0003] Typically, object location systems make use of multilateration techniques (i.e., the 
fixing of a position by the time difference of arrival (TDOA) of a signal at a sensor) to 
locate the origin of a transmitted signal. TDOA information is typically based on signal 
arrival-time measurements from an object that transmits, reflects or receives and re- 
transmits a signal that is received at receiving sensors. The TDOA measurements and 
other sensor information is typically transmitted to a central processor for processing. 

[0004] Methods for estimating position using TDOA are known. For example, "A 
Simple and Efficient Estimator for Hyperbolic Location" by Y. T. Chan and K. C. Ho. 
(IEEE Transactions on Signal processing, Vol. 42, No. 8, August 1994, pp. 1905-1915), 
which is incorporated herein by reference, provides techniques for implementing TDOA 
measurements. 

[0005] Other methods for determining the location and identification of a object are also 
known. For example, U.S. Patent No. 6,21 1,81 1, issued to Evers, discloses a method and 
apparatus for improving the surveillance coverage and object identification in a radar 
based surveillance system. 
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[0006] Another known method is disclosed in U.S. Patent No. 6,201,499, issued to 
Hawkes et al. As disclosed therein, it is known to provide a method and apparatus for 
measuring the time difference of arrival between two received signals, each received 
signal being a time delayed version of a transmitted signal as intercepted at two different 
sensors where the transmitted signal is generated by a radio frequency transmitter. 

[0007] Many drawbacks are present in existing systems and methods. For example, 
known systems and methods are often inaccurate and costly to implement. Other 
drawbacks also exist. 

SUMMARY OF THE INVENTION 

[0008] The present invention provides systems and methods for enabling computations 
that can be used to determine the position of a object using signal data at multiple 
sensors. Signal data may comprise any of Time of Arrival (TO A) data, Time Difference 
of Arrival (TDOA) data and Relative Time of Arrival (RTOA) data. These computations 
serve as an aid in the development position locating systems such as next generation air 
traffic control radar systems or the like. 

[0009] Accordingly, there is provided a method for determining the position of an object 
in a system comprising multiple sensors arranged at differing heights and including a 
reference sensor. In some embodiments the method may comprise transmitting or 
reflecting a signal from a object and then determining the time of transmission or 
reflection of the signal from the object. The method may then include receiving the 
transmitted or reflected signal at the multiple sensors and determining the TOA of the 
signal at each sensor. A processor-based calculator may calculate a slant range from the 
object to each sensor and a processor based calculator may calculate a position vector of 
the object. 

[0010] In accordance with some embodiments of the invention, there is provided a 
method for determining the position of a object in a system comprising multiple sensors 
arranged at differing heights and including a reference sensor. According to these 
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embodiments, the method may comprise transmitting or reflecting a signal from a object 
and determining the time of transmission or reflection of the signal from the object. The 
method also includes receiving the transmitted or reflected signal at the multiple sensors 
and determining the TDOA of the signal at each sensor. Then, processor based 
calculators may be used to calculate a slant range from the object to each sensor and to 
calculate a position vector for the object. 

[0011] In accordance with some other embodiments of the invention there is provided a 
method for determining the position of an object in a system comprising a sensor 
arranged at a determinable location and a secondary surveillance device that, at a 
determinable transmission time, transmits an interrogator signal that is reflected off the 
object, or received and retransmitted by the object, to a secondary sensor. In these 
embodiments the method may comprise obtaining a time of arrival for a signal received 
at the sensor and obtaining a secondary time of arrival for the reflected or retransmitted 
interrogator signal received at the secondary sensor. The method may also include 
implementing a processor-based calculator to calculate a slant range from the object to 
the sensor based, at least in part, upon the obtained time of arrival at the sensor and to 
calculate a secondary slant range from the object to the secondary sensor based, at least in 
part, upon the obtained secondary time of arrival at the secondary sensor. Finally, a 
processor-based calculator may be implemented to determine a position vector based, at 
least in part upon the transmission time of the interrogator signal, the calculated slant 
range and the calculated secondary slant range. 

[0012] In accordance with some other embodiments of the invention there is provided a 
method for determining the position of an object in a system comprising a sensor 
arranged at a determinable location. In these embodiments, the method may comprise 
obtaining a time of arrival for a signal received at the sensor. Then a processor based 
calculator may calculate a slant range from the object to the sensor based, at least in part, 
upon the obtained time of arrival. Finally a processor based calculator may enable a 
determination of a position vector based, at least in part, upon the calculated slant range 
and the location of the sensor. 
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[0013] In accordance with some other embodiments of the invention there is provided a 
method for determining the position of an object in a system comprising a sensor 
arranged at a determinable location and a reference sensor. In these embodiments the 
method may comprise obtaining a time difference of arrival for a signal received at the 
sensor with respect to a signal received at the reference sensor and implementing a 
processor based calculator to calculate a slant range from the object to the sensor based, 
at least in part, upon the obtained time difference of arrival. The method may also 
include enabling a processor based calculator to determine a position vector based, at 
least in part, upon the calculated slant range and the location of the sensor. 

[0014] In accordance with some other embodiments of the invention there is provided a 
system for determining the position of an object. In these embodiments the system may 
comprise a sensor, arranged at a determinable location, that obtains a time of arrival for a 
signal received at the sensor and a secondary surveillance device that, at a determinable 
transmission time, transmits an interrogator signal that is reflected off the object, or 
received and retransmitted by the object, to a secondary sensor and obtains a secondary 
time of arrival for the reflected or retransmitted interrogator signal received at the 
secondary sensor. The system may also comprise a slant range calculator that calculates 
a slant range from the object to the sensor based, at least in part, upon the obtained time 
of arrival at the sensor and a secondary slant range calculator that calculates a secondary 
slant range from the object to the secondary sensor based, at least in part, upon the 
obtained secondary time of arrival at the secondary sensor. Finally, the system may 
comprise a position vector calculator that determines a position vector based, at least in 
part upon the transmission time of the interrogator signal, the calculated slant range and 
the calculated secondary slant range. 

[0015] In accordance with some other embodiments of the invention, there is provided a 
system for determining the position of an object. In these embodiments the system may 
comprise a sensor arranged at a determinable location and a reference sensor, wherein a 
time difference of arrival is obtained for a signal received at the sensor with respect to a 
signal received at the reference sensor. The system may also comprise a slant range 
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calculator that calculates a slant range from the object to the sensor based, at least in part, 
upon the obtained time difference of arrival and a position vector calculator that 
determines a position vector based, at least in part, upon the calculated slant range and 
the location of the sensor. 

[0016] In accordance with some other embodiments of the invention there is provided a 
system for determining the position of an object. In these embodiments the system may 
comprise a sensor arranged at a determinable location wherein the sensor obtains a time 
of arrival for a signal received at the sensor and a slant range calculator that calculates a 
slant range from the object to the sensor based, at least in part, upon the obtained time of 
arrival. In addition, the system may comprise a position vector calculator that determines 
a position vector based, at least in part, upon the calculated slant range and the location of 
the sensor. 

[0017] Other aspects and features of the invention are possible. The following is a 
description of some exemplary embodiments of the invention. 

BRIEF DESCRIPTION OF THE DRAWINGS 

[0018] The purpose and advantages of the present invention will be apparent to those of 
ordinary skill in the art from the following detailed description in conjunction with the 
appended drawings in which like reference characters are used to indicate like elements. 

[0019] Fig. 1 is a schematic diagram showing an airborne object and a number of 
ground-based sensors according to some embodiments of the invention. 

[0020] Fig. 2 is a three-dimensional schematic diagram showing an object and a number 
of sensors according to some embodiments of the invention. 

[0021] Fig. 3 is a two-dimensional schematic diagram showing an object with five 
sensors according to some embodiments of the invention. 

[0022] Fig. 4 is a plot of TOA computation error contours with three sensors according to 
one embodiment of the invention. 
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[0023] Fig. 5 is a plot of TOA computation error contours with four sensors according to 
one embodiment of the invention. 

[0024] Fig. 6 is a plot of TOA computation error contours with five sensors according to 
one embodiment of the invention. 

[0025] Fig. 7 is a three-dimensional TOA schematic diagram showing an object with five 
ground-based sensors according to one embodiment of the present invention. 

[0026] Fig. 8 is a top- view of an error result for a three-dimensional TOA-based 
computation with four sensors in accordance with some embodiments of the invention. 

[0027] Fig. 9 is a side-view of an error result for a three-dimensional TOA-based 
computation with four sensors in accordance with some embodiments of the invention. 

[0028] Fig. 10 is a top- view of an error result for a three-dimensional TOA-based 
computation with five sensors in accordance with some embodiments of the invention. 

[0029] Fig. 1 1 is a side-view of an error result for a three-dimensional TOA-based 
computation with five sensors in accordance with some embodiments of the invention. 

[0030] Fig. 12 is a top- view of an error result for a three-dimensional TOA-based 
computation with six sensors in accordance with some embodiments of the invention. 

[0031] Fig. 13 is a side-view of an error result for a three-dimensional TOA-based 
computation with six sensors in accordance with some embodiments of the invention. 

[0032] Fig. 14(a) is a plot of TDOA computation error contours with three sensors 
according to one embodiment of the invention. 

[0033] Fig. 14(b) is a plot of TDOA computation error contours with four sensors 
according to one embodiment of the invention. 

[0034] Fig. 14(c) is a plot of TDOA computation error contours with five sensors 
according to one embodiment of the invention. 
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[0035] Fig. 15 is a top- view of an error result for a three-dimensional CH-TDOA-based 
computation with four sensors according to some embodiments of the invention. 

[0036] Fig. 16 is a side-view of an error result for a three-dimensional CH-TDOA-based 
computation with four sensors according to some embodiments of the invention. 

[0037] Fig. 17 is a top- view of an error result for a three-dimensional CH-TDOA-based 
computation with five sensors according to some embodiments of the invention. 

[0038] Fig. 18 is a side-view of an error result for a three-dimensional CH-TDOA-based 
computation with five sensors according to some embodiments of the invention. 

[0039] Fig. 19 is a top-view of an error result for a three-dimensional CH-TDOA-based 
computation with six sensors according to some embodiments of the invention. 

[0040] Fig. 20 is a side-view of an error result for a three-dimensional CH-TDOA-based 
computation with six sensors according to some embodiments of the invention. 

[0041] Fig. 21 is a schematic timeline of signals transmitted to a sensor in accordance 
with some embodiments of the invention. 

[0042] Fig. 22 is a schematic flow diagram of a method for computing object position in 
accordance with some embodiments of the invention. 

[0043] Fig. 23 is a comparison of contour error plots for two-dimensional TO A, CH- 
TDOA and RTDOA computations with three sensors in accordance with some 
embodiments of the invention. 

[0044] Fig. 24 is a comparison of contour error plots for two-dimensional TO A, CH- 
TDOA and RTDOA computations with four sensors in accordance with some 
embodiments of the invention. 
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[0045] Fig. 25 is a comparison of contour error plots for three-dimensional TOA, CH- 
TDOA and RTDOA computations with four sensors in accordance with some 
embodiments of the invention. 

DETAILED DESCRIPTION OF THE INVENTION 

[0046] The following description is intended to convey a thorough understanding of the 
invention by providing a number of specific embodiments and details. It should be 
understood, however, that the invention is not limited to these specific embodiments and 
details, which are provided for exemplary purposes only. It should be further understood 
that one possessing ordinary skill in the art, in light of known apparatuses and methods, 
would appreciate the use of the invention for its intended purposes and benefits in any 
number of alternative embodiments, depending upon specific design and other needs. 

[0047] The present invention provides a relatively efficient and cost-effective method 
and apparatus for determining the location of an object. For example, Fig. 1 is a 
schematic representation of an embodiment of the invention wherein the position vector 
(i.e., the distance and angular orientation as measured from an origin) of an object 100 
may be determined via information gathered at a number of sensors 102, 104, 106, 108. 

[0048] As schematically indicated in Fig. 1, object 100 may comprise an aircraft, 
however, the invention is not so limited. Object 100 may comprise any object capable of 
being detected by the appropriate sensors (e.g., 102-108). For example, object 100 may 
comprise aircraft, missiles, spacecraft (e.g., space shuttles, satellites, etc.), land vehicles, 
watercraft, or the like. In addition, object 100 may comprise any type of electronic 
device capable of being detected by appropriate sensors (e.g., 102-108). For example, 
object 100 may comprise cellular telephones, paging devices, GPS receivers, wireless 
radio transmitters, or the like. 

[0049] Similarly, while four sensors are shown in Fig. 1, the invention is not so limited. 
Any number of sensors may be used as is appropriate. In addition, the type of sensor 
may depend upon the type of position determining system being employed. For example, 
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position determining systems like radar, sonar, GPS, cellular, etc., each employ 
appropriate types of sensors to detect the relevant signals. 

[0050] It is also possible to practice the claimed invention in other configurations than 
the one shown in Fig. 1. For example, and as discussed in detail below, more or less 
sensors 102-108 may be employed in a variety of configurations. In addition, it is 
possible to use a mobile object location system wherein the system is contained, at least 
in part, in a spacecraft, aircraft, watercraft, or land-vehicle (e.g., MILSTAR satellite, 
AW ACS or JSTARS aircraft, or similar ship-based or vehicle-based systems). 

[0051] Figure 2 is a schematic depiction of an object position detection system according 
to some embodiments of the invention. As shown in Fig. 2, system 200 may be 
configured in a 3-dimensional rectangular coordinate system. System 200 may comprise 
a number, M, of sensors arranged at differing axis coordinates. As shown in Fig. 2, for 
some embodiments it is preferable to use six sensors, 205(a), 205(b), 205(c), 205(d), 
205(e), 205(f), positioned at various locations. 

[0052] In operation, a transmitted, or reflected signal (not shown) from the object 203 is 
received by each of the sensors, 205(a), 205(b), 205(c), 205(d), 205(e), 205(f). In some 
embodiments, the time of arrival (TOA) for the signal from the object to each sensor is 
recorded for later use in processing. Assuming that the time of transmission, or 
reflection, from the object is also known, a slant range (i.e., the line of sight distance 
between two points, not at the same level relative to a specific datum) 204(a), 204(b), 
204(c), 204(d), 204(e), 204(f) from the object 203 to each of the sensor 205(a), 205(b), 
205(c), 205(d), 205(e), 205(f) can be calculated in the following manner: 



[0053] 




(1) 



[0054] for in = l,...,Af where 
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sr_0 in = Slant range between each sensor in and object, 

t 0 in = Time of arrival, 
[0055] " 

t tgt = Time of transmission or reflection, 
c = Speed of light. 

[0056] An example of a slant range can be described with reference to the example of an 
airborne radar object (e.g., an airplane flying at high altitude with respect to a radar 
antenna). In that example, the slant range is the hypotenuse of the triangle represented by 
the altitude of the airplane and the distance between the radar antenna and the airplane's 
ground track. 

[0057] Because of possible delays and noise contamination of the received signal at each 
of the sensors 205(a), 205(b), 205(c), 205(d), 205(e), 205(f), errors may occur that may 
skew the accuracy of the TOA of the signal at each sensor. Therefore, in order to 
compensate for such an error, a known noise distribution (e.g., Gaussian noise) may be 
added to the TOA, yielding: 



[0059] where N( c) denotes a Gaussian random number with variance of O" 2 . 

[0060] The slant range between sensor in and the object 203, with the added noise, may 
be determined by subtracting the TOA of the transmitted or reflected signal from object 
203 to the already known time of transmission or reflection of the signal from the object 
203 and multiplying it with the velocity of the signal (e.g., the speed of light (c)), 



[0058] 



tin=t_0 in +N(C7,) 



(2) 



yielding: 



[0061] 



Fin — C ( ti n " ttgt ) 



(3) 



[0062] 



= c(t_0 in +N(<7,)-t tgt ) 



[0063] 



= c(t_0i n -t tg t) + + cN(<7 ( ) 



-10- 



PATENT 

Attorney Docket No.: 46417.001024 
Client Matter No.: D-GIL-0214 



[0064] 



r-m = sr_0 n + N( a, ) where o r = c<r, . 



(4). 



[0065] A position vector p = [ x y z J of the object 203 maybe calculated based on 

the TOA of the reflected or transmitted signal at each sensor t in , the slant range from the 
object to each sensor sr in and the known position of each sensor (i.e., the determinable 



"i _ 



for 



position vector Ps in of each of the M sensors in the coordinate system) Ps in = 
m=i,...,M. 

[0066] In some embodiments, a Lorentz inner product is used to calculate object position 
based on TOA information. Following that procedure, let Vj and v 2 be a pair of 4- 
element vectors: 



[0067] 



v, = 



x \ 




'x 2 ~ 


y, 








^2 = 














- W 2. 



[0068] Then, Lorentz inner product is then defined as 
[0069] (v„v 2 ) L = x l x 2 +y l y 2 +z y z 2 -w l w 2 . 

[0070] For each sensor in, the slant range can be expressed the following way: 
[0071] rdl = c 2 (t in - t tgt J = \Ps in - P tgt f = (x in - x m } + {y in - y tgt J + (z in - z tgt ) 2 , 



[0072] or 

[0073] (x in - x lgl f + (y in - y tgt f + (z in - z m f-c 2 (t in - t lgl f = 0. 

[0074] Reorganizing the equation gives: 
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[0075] 2x in x, gl + 2y in y lgl + 2z in z tgl -2ctj v = (x\, + yj, + zj, -c 2 ^)+ (x 2 + y 2 + z 2 -c 2 r 2 ). 

[0076] Let /I = x 2 , + yf gl +z\, ~c 2 t\ t , and organize the equations in=l,...,M as a linear 
system so that 

[0077] 2-A-v = A-I _v + b 

[0078] where 
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[0079] A = 




y m 








ytgt 


, i. 


.v = 


1 


, b = 
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1 





X 2 + y 2 + Z J _ c 2,2 



x 2 M +yl+z 2 M -c 2 t 2 M 



[0080] Depending on the value of M, the matrix A may or may not be a square matrix. 
Assuming thatM > 4 , the method of least squares is applied by multiplying both sides 
with A T so that 



[0081] 

[0082] where 
[0083] 



2A T Av = AA T I _v + A T b 

v = i (A T AY A t I _ v X + \ (a t aY A T b 
= dX + e 



d=\{A T AYA T I_v, 
e=\(A T AYA T b. 



[0084] Taking the Lorentz inner product of v with itself gives 
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[0085] 



2 — V 2 -4- V 2 _|_ 7 2 —r 2 t 2 

= <v.v) t 

A = ( J, J) ^ A 2 + l{d, e) L X+ (e, e) L 



[0086] This results in a quadratic equation with respect to X: 
[0087] (d,ctj % + (2(^,e) L -\)X + {e,e) L = 0. 



[0088] Solving for A gives 



[0089] 



4 = 



- {2(d,e) L -l)±J(2(d,e) L -lf -4(dJ)^) L 
2(d,d) L 



[0090] Once X is calculated, v is obtained by 



[0091] 



7 



tgt±_ 



- v ± =d - A, ± +e. 



[0092] Now, two possible positions of the object are given by this computation. In order 
to choose the right solution, the following vectors are computed: 



r_ch ± = 



tgt± 



Ps -P 

r *in r tgt ± 



sr. 



sr, 



M 
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[0093] The vector with the smallest error norm of r_ch ± can be chosen as the correct 
position of the object. 

[0094] An exemplary calculation of an object position vector is made with reference to 
Fig. 3. As shown in Fig. 3, a two-dimensional position location system 300, 
implementing a TOA based calculation, may comprise positioning four sensors (Si) 
305(b), (S 2 ) 305(c), (S 3 ) 305(d), (S 4 ) 305(e), and a reference sensor (S 5 ) 305(a) in a 
20X20 mile 2-dimensional grid at locations given by the following sensor position 





"15" 




"-15" 




"-15" 




15" 




"0" 


vectors: Ps x = 




, Ps 2 = 




, Ps,= 




, Ps 4 = 




, Ps 5 = 






10 




10 




-10 




-10 




0 



[0095] For calculation purposes, each grid node may be considered an object location. 
For each object position, the position vector calculation comprises estimating the position 
of the object for each sensor using slant range values at each sensor 305(b), 305(c), 
305(d), 305(e), to compute the position of the object. 

[0096] The above described system and TOA computation may be generalized so that it 
can be employed in a three dimensional (3-D) situation. In addition, the above system 
and TOA computation allows for the deployment of an unlimited number of sensors, so 
that a more accurate computation of the position of the object may be performed. Then, 
for each object position, the TOA computation may be used to estimate object position 
based on the noise added range data. In addition, a Monte-Carlo approach (or other 
numerical approximation method) may be employed to compute the standard deviation of 
the error between the true position of the object and the estimated position of the object. 
The standard deviation of Gaussian error added to the range may be a r - 2.24 X 10" 3 , or 
some other suitable value. 

[0097] Proceeding with the calculations for each of the sensors sensor 305(a), 305(b), 
305(c), 305(d), 305(e), the slant range in can be expressed as: 

[0098] sf in = c\t in -t tgt ) 2 ... (5) 

-14- 



PATENT 

Attorney Docket No.: 46417.001024 
Client Matter No.: D-GIL-0214 



[0099] In terms of the positions of each sensor 305(a), 305(b), 305(c), 305(d), 305(e) and 
the position of the object at each position 303(a), 303(b), 303(c), 303(d), slant ranges 
307(a), 307(b), 307(c), and 307(d) may be determined using the following relationship: 



[00100] 



sr 2 in = \\Ps ln -P, 



- I|2 
P 

m 1 tgt 



(6) 



[00101] sr 2 in = ( x in - x tgt ) 2 + ( y in - y tg t ) 2 + ( z in - z tgt f 

[00102] In other words, equation (6) may be re-written as: 

[00103] ( x in - x tgt ) 2 + ( y in - y tgt f + ( z in - z tgt ) 2 - c 2 ( t in - t tgt ) 2 = 0, and 
reorganizing the equation yields, 

[00104] 2x in x tgt +2yin y tg t + 2z in z tgt -2ct in t tgt = ( x tgt 2 + y tgt 2 + z tgt 2 - c 2 t,g, 2 )+( x in 2 + 
yi„ 2 + z in 2 -c 2 ti„ 2 ) 



(7) 



[00105] letting: X = x tgt 2 + y tg ? + z tgt 2 - c 2 t tgt 2 which is a Lorentz 

invariant, and organizing equation (7) for in = 1....M, above as a linear system, it 
becomes, 



[00106] 2. A. v = X .I_v+ b 
[00107] where, 



(8) 
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[00108] 
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z lgl 


, /_v = 
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xl + yf n +zl-c 2 tf n 
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~ Ct M. 




ct, g <_ 




1 




/ M +y 2 M+zl-c 2 t 2 M 



[00109] and depending on the value of Af, the matrix A may or may not be a square 
matrix. Assuming that M > 4 , the method of least squares may be applied by 
multiplying the transpose of A (A T ) by both sides of equation (8) above, yielding: 
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[00110] 2 A T A v = X A T I_v +A T b (9) 

[00111] solving for v, 

[00112] v = Vi ( A T A )*' A T I_ v . X + 1 / 2 ( A T A )"'A T b 

[00113] v=dX + e (10) 

[00114] where, 

[00115] d = Vi ( A r A VU'/.v am* e = 14 ( A T A )"'A r £ 

[00116] Taking a Lorentz inner product of v with itself gives, 

[00117] X = (v,v) l 

[00118] X = (d.X + e,d.X + e) L (11) 

[00119] A = (dJ)X 2 +2(d,e) L X + (e,e) [ , this results in a quadratic 

equation with respect to A , yielding 

[00120] (dj)^ 2 + fc(d 9 e) L -l)* + (e,e) L =0 (12) 

[00121] solving for A yields, 



-( 2 (J,^ -l)±i2(J,?> t -l) 2 -4(j,J) 
[00122] X ± = 5!— —. i (13) 

[00123] From the quadratic equation above, X can be calculated, and hence, v can 
be obtained by 
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[00124] 



= v ± = d.Z ± + e 



[00125] Because X yields two values from the solution of equation (13), which are 
two possible positions of the object, therefore, in order to ascertain the correct position of 
the object, the following vectors may be computed: 



[00126] 



rjoh ± = 



tgt±\ 



Ps -P 



sr. 



sn 



M 



[00127] From the computation above, the vector with the smallest error norm of 
r_ch ± may be chosen to be the correct position of the object. 

[00128] Figure 4 is a contour plot of the standard deviation of the resulting error 
for three sensors used in determining the location of an object according to some 
embodiments of the invention. Likewise, Figure 5 is a contour plot of the standard 
deviation of the resulting error for four sensors used in determining the location of an 
object according to some embodiments of the invention and Figure 6 is a contour plot of 
the standard deviation of the resulting error for five sensors used in determining the 
location of an object according to some embodiments of the invention. 

[00129] As can be seen from Figs. 4-6, the error is relatively small inside the 
sensor configuration, and it becomes larger for objects positioned away from the center. 
In particular, Fig. 4 demonstrates that the error values are particularly large along the rays 
that are collinear to the line segments connecting sensor pairs. One reason for this large 
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error may be that the discriminant in the quadratic expression of X is zero or nearly zero, 
and that may contribute to large errors in the calculation. Another inference that can be 
surmised from Figs. 4-6 is that adding more sensors dramatically improves the accuracy 
of the position determination. 

[00130] Another exemplary embodiment of the invention is discussed with 
reference to Figure 7. Figure 7 is a schematic diagram of another embodiment of position 
location system 400 using a 3-dimensional coordinate system to implement a TOA 
computation. As shown, this embodiment may comprise positioning six sensors 405(a), 
405(b), 405(c), 405(d), 405(e), and 405(f) in a 20X20 mile grid at the following position 
vector locations: 
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discussed above, for calculation purposes, each grid node may be considered to be an 
object position. For each object position, an estimate of the position of the object for 
each sensor may be performed by using slant range values at each sensor 405(a), 405(b), 
405(c), 405(d), 405(e), and 405(f). Then, a similar calculation as above is used to 
estimate object position based on the noise added range data. 

[00131] Figures 8-13, are schematic representations of results of the calculation for 
each grid node presented in terms of a line segment connecting a true position of the 
object represented by a circle, and a simulated position of the object, represented by an 
'x' symbol, so that the greater the segment length connecting the two points, the worse 
the error. In other words, where the circle and the x coincide (e.g., ®) there is relatively 
small error. 

[00132] Figure 8 is a schematic representation of the above described error plot for 
a three dimensional case using four sensors and viewed from the top. Figure 9 is a 
schematic of the same three dimensional, four sensor plot as Figure 8, except the view is 
from the side. 
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[00133] Figure 10 is a schematic representation of the above described error plot 
for a three dimensional case using five sensors and viewed from the top. Figure 1 1 is a 
schematic of the same three dimensional, five sensor plot as Figure 10, except the view is 
from the side. 

[00134] Figure 12 is a schematic representation of the above described error plot 
for a three dimensional case using six sensors and viewed from the top. Figure 13 is a 
schematic of the same three dimensional, six sensor plot as Figure 12, except the view is 
from the side. 

[00135] As demonstrated in Figs. 8-13, the results of the position calculation for 
the above described TOA computation gives quite accurate results near the sensor 
positions. Away from the sensor positions, the results of the TOA computation are not as 
accurate. The trend in values of the mean squared error seems to indicate that adding 
more sensors may improve the accuracy, but not by too much because sensor positions 
along the z-axis may be limited by practical considerations. 

[00136] Some embodiments of the invention may perform object position 
computation using a TDOA computation. Some methods of performing TDOA 
computations are known. For example, the above noted paper by Chan and Ho describes 
a TDOA calculation. 

[00137] In contrast to the TOA computation, the TDOA computation uses the 
difference of the time of arrival at each sensor with respect to a reference sensor to 
compute the position of a object. Therefore, the set of equations to be solved is 
somewhat different. Also, the time of transmission or reflection may not be needed. 

[00138] First, a description of a Taylor Series TDOA (TS-TDOA) method of 
computing object position is provided. Initially, the position of the object is such that 





x i g i 


= x c +Ax 


[00139] 


ytgt 


= y c +Ay 




z t gt 


. A - 
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[00140] Then, the slant range equation for each in can be expanded as a Taylor 
series about (x c ,y c ,z c ) so that 



[00141] 



«i„ =-Jk, -x lgl f +{y in -y v ) 2 +[z iH -zj 2 



[00142] Letting sr c h = -*J* + (?« ~ 7 e Y + (z,„ z c )* and ignoring higher 
order terms gives 



[00143] 



sr. 



sr 



Sr c in 



[00144] Now, the range difference equation with respect to sensor 1 may be 
defined for each in so that 



sr _ n !m , a sr.. - sr. 



[00145] 



[00146] 
[00147] 
[00148] 

[00149] 



^c* ^» 
»i I «"c 1 Sr c 1 



V Sl c I 5r c « J V 5# * 1 Sr c in J \ Sr c 1 SK c in j 

Reorganizing the equations m=2,..., M as a linear system gives 



GJ ts =K 



where 





fa 




(*-*) 




"fl 




sr e , 


"t 2 


jr f , sr e2 






(v,-yj 


: (^-yJ 






Sr c in 






^ C 1 in 






(y,-yJ 


(y M -y e ) 





sr_n u -(sr e2 -sr el )~ 
" , -«jf.i-(w , c*-« p ei) 
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[00150] With this linear system, an iterative approach may be used to compute the 
values of (x tgJ , y Jgt , z tgt ). One of example of an iterative approach is as follows. 

[00151] The TS TDOA computation begins with range difference values sr _ n in X 
already known, for m=2,...,M. Then, an initial guess on the values of the object position 
(jt°,3>°,z°) may be made with 0 as an index for initial guess of the iteration. Then, the 
slant range value sr c in may be calculated for w= /,..., Af based on the guess of the object 

position. Once sr c in is calculated, the linear system G ts v ts = h ts can be solved as a least 
squares problem for an over-determined system so that 

[00152] v ts = (GlQ l GxY Gj s Q~ x h ts 

[00153] where Q is the covariance matrix of dimension (M-l)x(M-l) and is related 
to the random errors associated with the difference in range values, nominally set to 1 
along the diagonal and 0.5 for the off-diagonal elements. Then, a new set of guess values 

can now be computed from v ts = [Ax Ay Azf so that 

Ax" 
Ay 
Az_ 

[00155] where N is the iteration index. The steps may be repeated with the new 
guess of the object position by going back and calculating again. If the initial guess is 
reasonably accurate, the solution vector should converge to the position of the object 

tgt ' ytgt ' Ztgt ) • 

[00156] One problem with a TS TDOA computation is that it is an iterative 
method. If the initial guess is poor, then the iteration may not converge to the correct 
solution. In particular, when computing the object position using a computer processor 
the initial guess has to be somewhat close to the correct object position to achieve 



[00154] 
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convergence. This can be inconvenient. In addition, the TS TDOA uses the first order 
Taylor series approximation, and there may be cases where the approximation gives an 
incorrect solution as well. However, in some embodiments the TS TDOA computation 
may be implemented as a reference as discussed below. 

[00157] Another TDOA computation that avoids some of the drawbacks of the TS 
TDOA and can be used to compute object position is based upon the work of Chan and 
Ho. Herein this computation is called the CH TDOA. First, a set of difference equations 
in slant range are defined with respect to sensor 1 so that for in= Af, 



[00158] 



[00159] 



Or, 



[00160] 



sr in =sr_n inA +sr r 



[00161] 



Squaring both sides gives 



[00162] 



sr* =(sr_n inl + sr t f 

= sr_nl A + 2sr_n in ^sr l + sr? 



[00163] 



On the other hand, 



[00164] 



sf- n = (x in - x tgl ) 2 + (y in - y lgt ) 2 + (z in - z lg , f 

i) + (*/g/ + ytgt + z tgt ) — 2x in x lgl —2y in y tgl —2z in z tgr 



= (4n+yfn+zl t )+(xl+yl l +zl 



[00165] Equating the two gives: 



[00166] S r _ i£j + 2sr _ n in i sr, + sr? = (a£ + + z^)+ + y\, + z 2 J- 2x ln x, gl - 2y„y w - 2 Zin Z lgr 



[00167] 



The terms x) , y] , and zt, make the expression nonlinear. Therefore, a 



subtraction is applied using the in=l equation so that for in=2,...,M, 
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sr _ nl , + 2sr _ , sr, + sr, 2 - sr? = [xl + y? + z* )+ + y%, + z, 2 , )- 2^^, - 2 yill y, s , - 2z toZl! , 

- (U 2 + >, 2 + z> J )+ (4 + y«, + 4- )- 2x > -v - 2 y>y<p - 2 v J 

sr - "L + 2w_ = -2fa - Jr, K, - 2(y i „ - y, )>-,,, - 2(z fa - z, )z, ? , 
+ + >^ + 4 )- U 2 + + zf) 

These equations, for in=2,...,M, can be recast as a linear system so that 
G a v = h 

where 



G = 



Assuming that M>3, the linear system can be solved as a least squares 



-2{x, 


-*,) 2(y 2 -y,) 


2(z> 
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2f_n J ," 
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- 2{x, 


-*,) 2(y„-y,) 
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-*,) 2(y»-y,) 


2(z„ 




2f -"„., 










+ yi+zi)+U 2 + y l 2 + z 1 2 ) 



[00173] 

problem. 



[00174] First, the error vector is defined as y/ = G a v - h . Since Gaussian errors are 
involved, the least squares method is applied to minimize 



[00175] 
[00176] 
[00177] 
[00178] 

[00179] 



which is solved by 



where 



V = Exp(ysys T ), 

= Expectation value of y/y/ 1 ' . 



[00180] The covariance matrix *F is approximated by 



[00181] 



¥ = c z BQB 
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[00182] 



where 



[00183] 



0= 



1 0.5 •• 
0.5 1 0.5 
i 0.5 1 

... 

0.5 



0 



0.5 



0.5 
1 



, B = diag(sr_0 2 ,sr_0^...,sr_0 M ). 



[00184] The matrix Q is the ( M-l )x(M-l) covariance matrix of time-difference-of- 
arrival, and it is assumed that there is some correlation between the time-difference 
samples as reflected by the nonzero off-diagonal elements. The matrix B is a diagonal 
matrix with elements {sr_0 2 ,sr_0 3 ,...,sr_0 M ). Since B is not known prior to the 
computation, it is approximated by solving 



[00185] 



v 0 = (G T a Q- , G a )' l G T a Q- l h, 



[00186] and determining from v 0 the approximate slant range values 

(sr _0 2 , sr_0 3 sr_0 M ) . 



[00187] Once *F is computed from the approximate value of B and Q, v, is 
computed from 



[00188] 

[00189] where 
[00190] 



v. = 



*v y, g , sr > 



r 



[00191] Now, the computed solution v, is refined by imposing the condition that 



[00192] 



sri =e l +e 2 +e 3 . 
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[00193] 



where 



[00194] 



[00195] 



[00196] 



[00197] 
[00198] 
[00199] 

[00200] 



[00201] 
[00202] 
[00203] 
[00204] 
T002051 



e \ — { x i x t g i ) » 



This gives a new over-determined system to solve: 



e i ~ i x \ x tgt ) ' 

«2=(yi -y !s ,) 2 > 

g 3 = i Z l ~ Z tgt ) > 



e t +e 2 +e 3 = sr\ 



As a linear system, 



Gv=h 



where 



G = 



"1 
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0" 
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(y, 












, v = 
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rdx 



As a least squares problem, the function to be minimized is 

LS = (h-G a v) T V- l {h-G a v) 

where the covariance matrix is approximated by 

V = BG-jQG T a ~ l B 

with 
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B = diag\ x lgl - or, , y [gl - y x , z, gl - z, , sr , 



Thus, 



= (gJ [B- l G T a Q- x G a B- x )g o )" • (Gj (fl-'GjG-'G^- 
Once v is calculated, the refined solution is computed by 



[00206] 
[00207] 

[00208] 
[00209] 

[00210] 



[00211] Because of the square root involved, there are up to eight possible 
solutions. In some embodiments, the solution is selected by choosing the solution closest 
to the approximate solution [x tgn y tgJ , z tgt ) that was determined above. 

[00212] In a two dimensional (2-D) case with three sensors, the position of the 
object can be found without resorting to least squares method. In this case, the difference 
equations can be written 



x tgt 












yi 




_ z igt _ 









[00213] 



*2-*i yi-y\ 



"igi 
ytgt 

\t 
y tgt 



sr _ 




1 






sr. + — 


sr _ 


- n li_ 


1 2 



sr_n 2 2A -(x 2 2 +y 2 2 )+(xf +yf) 
sr_nl l -{x 2 3 +y 2 3 )+(xf + y 2 ) 



a x ■ sr x + b { 
a, • sr, + b 0 



[00214] and substituted into 
[00215] 



2 =(*« -Xi¥ + (y v -yxY 



1002161 



to eive 
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[00217] 

[00218] where 
[00219] 



a ■ sr, 2 + P ■ sr t + y = 0 



a = (af+al-\\ 

0 = a i {b l -x i )+a 2 {b 2 -y i \ 

r=(b l -x l f + {b 2 -y l f. 



[00220] 



Solving for sri gives 



sr i± = 



2a 



x tgt± 




a \ ' sr \± + b\ 


_?tgt±_ 




_a 2 sr l± +b 2 



[00221] 

[00222] From srj , 
[00223] 



[00224] From the two possible solutions, the correct solution can be determined by 
calculating the resulting range values and comparing them with the actual data. 

[00225] In a three dimensional (3-D) case with four sensors, the position of the 
object can be found without resorting to least squares method. In this case, the difference 
equations can be written 



[00226] 



* 2 -*i y 2 -yi *2-Zi 
h~ x \ y^-y\ 

*4-*l 3^4-^1 Z4-Z| 
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sr_r4, - U + y\ + z 2 2 )+ L 2 + yf + z, 2 



sr_n*j - [x] + y\ + z 3 2 )+ [xf + yf + z, 
sr _ nl , - (x 2 + y 2 + z 4 2 )+ (x 2 + y, 2 + zf ) 



a, • sr, + fr, 
-sr, +b 2 



[00227] 
[00228] 



and substituted into 



= (** - *. f + {y, s , - y. ) 2 + 1„ - ^. ) 2 
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to give 



asr* +P-sr { + y = 0 



where 



a = {al +al+al-\\ 

0 = a l (b l -x l )+ a 2 {b 2 - y x )+ a 3 {b 3 - z, ), 

r = (b l -x l ) 2 + (b 2 -y l f + (b i -z l f. 



[00233] Solving for srj gives 



sr l± = 



_ -yg±V/? 2 -4ay 
2a 



x tgt± 




a, 


■sr l± 


+ *>,- 






a 2 


■sr l± 




_ z tgt± _ 




_a 3 


■sr l± 


+ ft 3 



[00234] 



[00235] From sn , 



[00236] 



[00237] From the two possible solutions, the correct solution can be determined by 
calculating the resulting range values and comparing with the actual data. 

[00238] The CH TDOA may be performed for a nominal 2-D case in the same 
manner as the TOA computation described above. The sensors are positioned at the same 
locations as in the 2-D case for the TOA computation. 

[00239] For this computation, a grid covering a 20 mile x 20 mile region and 
encompassing the sensors is used so that each grid node may be considered to be a object 
position. Then, for each object position, the CH TDOA method described above may be 
used to estimate object position based on the noise added range data. A Monte-Carlo or 
other numeric approximation approach may be employed to compute the standard 
deviation of the error between the true position of the object and the estimated position of 
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the object. The standard deviation of Gaussian error added to the range may 
be<7 r =2.24xl0~ 3 . 

[00240] In Figures 14(a), 14(b) and 14(c), contour plots of the standard deviation 
of the resulting errors are shown. As shown in the Figures, the error is small inside the 
sensor configuration, and it becomes larger for objects positioned away from the center. 
In particular, as shown in Fig. 14(a), it is the error values are relatively large along the 
rays that are collinear to the line segments connecting sensor pairs, similar to the results 
in the TOA computation case for 2-D. It turns out that along these rays, the discriminant 
in the quadratic expression of sr l± above is zero or nearly zero, and that may contribute to 
large errors in the CH TDOA calculation. 

[00241] Figure 14(b) shows the results for four sensors, there are certain regions 
inside the sensor configuration where the error increases dramatically. This result differs 
greatly from the results of the same sensor configuration with the TOA computation. 
Examining the matrix G a shows that, if a object is in those regions, either the difference 
of the range values or the difference of the components of the sensor positions are zero or 
nearly zero. This renders the matrix G a nearly singular and results in poor estimation of 
the object position. On the other hand, and as shown in Fig. 14(c), adding an additional 
sensor removes these blind spots, and the results appear to be better than that of the 
results obtained using the TOA computation. 

[00242] In a manner similar to the TOA computation, the CH TDOA computation 
can be applied to a nominal 3-D case. In the following, the numbers are dimensionless 
for convenience, but in practice can correspond to any suitable scale (e.g., miles, 
kilometers, etc.). The sensors are positioned at the same locations as those used in the 3- 
D case for the TOA computation. 

[00243] As before, a grid covering a 20x20x10 dimensionless region and 
encompassing the sensors is used so that each grid node is considered to be a object 
position. Then, for each object position or grid node, the CH TDOA computation may be 
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used to estimate object position based on the noise added range data. The standard 
deviation of Gaussian error added to the range is<j r = 2.24 xlO" 3 . 

[00244] Figures 15-20 are schematic representations of results of the calculation 
for each grid node presented in terms of a line segment connecting a true position of the 
object represented by a circle, and a simulated position of the object, represented by an 
'x' symbol, so that the greater the segment length connecting the two points, the worse 
the error. In other words, where the circle and the x coincide (e.g., ®) there is relatively 
small error. 

[00245] Figure 15 is a schematic representation of the above described error plot 
for a three dimensional case using four sensors and viewed from the top. Figure 16 is a 
schematic of the same three dimensional, four sensor plot as Figure 15, except the view is 
from the side. 

[00246] Figure 17 is a schematic representation of the above described error plot 
for a three dimensional case using five sensors and viewed from the top. Figure 18 is a 
schematic of the same three dimensional, five sensor plot as Figure 17, except the view is 
from the side. 

[00247] Figure 19 is a schematic representation of the above described error plot 
for a three dimensional case using six sensors and viewed from the top. Figure 20 is a 
schematic of the same three dimensional, six sensor plot as Figure 19, except the view is 
from the side. 

[00248] In Figures 15-20 it is shown that near the sensors, the CH TDOA 
computation gives quite accurate results. Away from the sensors the computation is not 
as accurate. 

[00249] The plots in Figure 17 and 18 indicate that there are certain localized 
regions where the G a matrix is once again nearly singular and causing poor results. 
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Adding one more sensors may dramatically improve the results as shown in Figure 19 
and 20. 

[00250] As with the TOA computation, the trend in the values of mean squared 
error for CH TDOA seems to indicate that adding more sensors may improve the 
accuracy, but not too much since the sensor positioning along the z-axis is limited. 

[00251] Comparing the CH TDOA six sensor case in Figures 19 and 20 and the 
TOA six sensor case in Figures 12-13 shows that CH TDOA computation is more 
accurate than the TOA computation especially when multiple sensors are used. 

[00252] Thus, for some embodiments of the invention, the CH TDOA computation 
works better in terms of accuracy when the number of sensors used is five or more for 2- 
D and six or more for 3-D. When the number of sensors is one or two more than the 
spatial dimension, there may be certain regions or blind spots where the CH TDOA 
computation fails because the associated matrix G a becomes nearly singular. In such 
cases, TOA computation appears to work better. 

[00253] Referring again to Figure 2, another embodiment of the invention is 
described wherein an addition method of computing object position is implemented. As 
shown in Fig. 2, there are M sensors with differing heights positioned at various locations 
of the x-y plane. A transmitted, or reflected signal from the object is received by the 
sensors so that the TOA of the signal from the object to each sensor is known. Assuming 
that the time of transmission, or reflection, from the object is also known, the slant range 
from the object to each sensor can be calculated: 

[00254] sr_0 in =c(t_0 in -tj 
[00255] for in = 1,..., M where 
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[00256] 



sr_0 in = Slant range between sensor in and object, 
t_0 in = Time of arrival, 
t tgt = Time of transmission or reflection, 
c = Speed of light. 



[00257] It is likely that the actual times of arrival have errors in them; so, a 
Gaussian noise is added to the time of arrival so that 

t in =t_0 in +N{o,), 



[00258] 



"i. =<4»-'«r) 

= c{t_0 in+ N{a l )-tJ 
= c(tJ) in -t lg ,)+cN{<r t ) 
sr in =sr_0 n +N{<j r ), 



[00259] 



where 



[00260] 



o r = ca.. 



[00261] The term N( a) denotes a Gaussian random number with variance of o 2 . 

[00262] So, the TDOA computation is to be used to calculate the position vector 
? v = \ x , gt y, g , z, e ,Y of me object based on the following data set: 



[00263] 



t in = Time of arrival, 
sr in = Slant range from target to sensor, 



Ps ; „ = 



y» 



= Position of each sensor, 



[00264] 



for in=l,...,M- 



[00265] We introduce the following notations for convenience. First, a pair of 
nominal vectors is defined as 
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[00276] 

[00277] 

roots gives 
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X, 




~yi 


[00266] x = 


x 2 


J = 






_*3_ 







[00267] Then, an inner product is defined as 
[00268] {x,y) = x l y l +x 2 y 2 +x ) y v 

[00269] The norm of a vector is then defined as 
[00270] 



H = ^{x,y). 
Using the above notations, for in=2,...,M- 



c(t in -t l ) = c(t in -t lgt +t lgt -t l ) 

= c(t in -tj-c(t l -t lgl ) 



= sr in -sr r 



On the other hand, 



[00273] 
[00274] 

[00275] Combining the two expressions gives 



c(f fc -'i)=|ft*. -^||-||^.-jU 



Multiplying both sides by \\Ps in -P tgl +\\Ps i -P, K ,l to remove the square 
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-U + l^-' p J= -M + \h -M) 



1 * tgt\\ || J "i/i tgi\\ 

- I|2 II- - ||2 



=\h*- p J-\h-U 

= (K - A* > - 2(ft in . ft», ) + ( Ps v , Ps, p ) 
- (Ps, ,Ps,) + 2(Ps, , ft„ ) - (Ps m , /\,) 



[00279] On the other hand, 



[00280] 



= c{t in -t l ic(tin-tj+c(t l -t lgt )) 

= c 2 {t in -t l )(t in +t l -2t tg ) 

= c 2 {t in -tjt in +t l )-2c 2 {t ia -t 1 )t, gl . 



[00281] 
[00282] 



Combining the two gives: 



PS : , 



[00283] Rearranging it gives: 



[00284] Equation 1: 



[00285] (IPs, -2Ps in ,Ps tgl ) + 2c 2 (t in - ti )t tg , = |Nf -\\h n ( +c 2 {t in -t x \t in +?,). 



[00286] Now, let the unknown be a vector: 



[00287] 



v = 



~tgt 
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[00288] 



Then, Equation 1 can be set up as a linear system for in=2,...,M so that 



[00289] 



2x,-2jc 2 2y,-2;y 2 2z,-2z 2 2c(/ 2 -f.) 
2x,-2x,„ 2^,-2^ 2z,-2 Zj „ 2c(t ln -t,) 
2x,-2x M 2y x -2y M 2z,-2z M 2c(r M -f,)_ 



-\Ps 2 \ +c 2 (, 2 -t,Xt 2 +t,) 

l^ 1 | 2 -|^«| 2 +^ 2 ('« -'>)('«+'■) 



[00290] 



[00291] 



or 



Gv = h 



[00292] In yet another embodiment of the invention, there is provided a method for 
computing object position using relative time of arrival (RTOA) signals. With reference 
to Figure 2, there may be Ns sensors with differing heights positioned at various locations 
of the x-y plane. In addition, there may be an additional radar source. For example, a 
secondary surveillance radar (SSR) may be incorporated as described below. 

[00293] In Figure 21, a time history of a signal from the SSR to each of the 
receiver sensors is shown. The interrogator signal from the SSR radar is transmitted at to 
and is reflected by an object at t tgt . The reflected signal is then is received by the sensors 
so that the time of arrival of the signal from the object to each sensor is known. 

[00294] The slant range from the object to each sensor can be calculated as: 



[00295] 



[00296] 



for in = 1,..., Ns where 



[00297] 



sr in = Slant range between sensor in and object, 
t in = Time of arrival, 
t = Time of reflection, 
c = Speed of light. 
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[00298] The slant range from the object to the SSR is calculated as: 
[00299] sr 0 =c{t tgt -t 0 ). 

[00300] If the position of the object is represented as p = [ Xfgt y z , gt } > the slant 
range between the sensor in and the object is 



[00301] 



sr in =\\Ps in -P tgt 



[00302] So, the proposed RTOA computation is used to calculate the position 
vector p = [ x y Ztgt Y of the object based on the following data set: 

t Q = Time of transmission from SSR, 
f . = Time of arrival, 



[00303] 



Ps Sm = 



Ps = 







y in 




- Z in. 




X SSR 




yssR 


_ Z SSR 





= Position of SSR, 



[00304] 
[00305] 

[00306] 



for in=l,...,Ns. 

Using the above notations, for in=l,...,Ns: 



c{t iR -h) = c(t in -t tgt + t tgt -t 0 ) 

= c{t in -tj+c(t lgt -t 0 ) 



= sr in +sr 0 . 



[00307] On the other hand, it is known that 
[00308] sr in = \\Ps in - P tgl \\ and sr 0 = \\Ps SSR - P t 

[00309] Combining the two expressions gives 



ig'W 
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[00310] 



c{t in -t 0 ) = \\Ps in -R 



P S SSR Pigt > 



[00311] 
[00312] 
[00313] 

[00314] 



or 



Squaring both sides gives 

=(^-to)-\\pss Sli -K,\J 

\\PsJ( -2(Ps in , Ps lg ,) + lK( = c 2 (t in ~t 0 f -2c(t„ " K\ 

+ r S SSR 



[00315] Reorganizing the equation gives 



[00316] (-2^. +P* m ,/\,)+2c(f in -fol^-^lh^ 2 ^ -O 2 -||^f 



[00317] Now, define a new variable 



[00318] 



Sr 0 ~ \P S SSR ^tgt 



[00319] This then allows the equations for in=l,..., Ns to be recast as a linear 
system of equations 



[00320] 



A,v,=fc, 



[00321] with the unknown vector defined as: 
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[00322] 



v, = 



y<gt 



sr 0 



[00323] and 



[00324] 



4 = 



-2x x +2x SSR -2 yi +2y SSR -2 Zi +2z SSR 2c(f,-f 0 )' 
-2x in +2x SSR -2y in +2y SSR -2z k +2z SSR 2c(f h -t 0 ) 
-2x Ns +2x SSR -2y Ns +2y SSR -2z Ns +2z SSR 2c{t Ns -t 0 \ 



- l|2 

PsA\ + 



Ps 



ssr\\ 



c 2 (^-^o) 2 -||^,J| 2 + 



Ps 



SSR\i 



C 2 {t N s-to) 2 -\\Ps N s( + 



Ps 



SSR\\ 



[00325] The method of least squares can be used to solve this linear system so that 



[00326] 



v i =(Alp- l A i YA T P- , -b l 



[00327] where P is the measurement covariance matrix nominally set as identity 
matrix of dimension NsxNs. 

[00328] Using Chan and Ho's technique, the covariance matrix Hj of the error 
vector ev, = A,v, -b x is approximated from v, : 



[00329] 



H x = c 2 C,PC, 



[00330] where 
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0 


0 


0 


0 




0 




0 


0 


0 




0 


0 




0 


0 




0 


0 


0 




0 




0 


0 


0 







[00332] 



Sr in ~ \P S in ^tgth^tgt ~ 



~tgt 



[00333] Now, a more refined solution vector is computed, if desired, by solving 



[00334] 



v x =(AlH?A x yAlH?-b x 



[00335] Once v { is computed, a refinement step similar to the one employed by 
Chan and Ho, can be used to obtain a more accurate solution. 



[00336] 



[00337] 



Consider a system: 



d\ — { x ssr x t g t J 2 ' 

d 2 ={y S sR-y tgt ) 2 > 

^3 = i Z SSR ~~ Z tgt J » 



_ 2 

d x +d 2 +d 3 = sro . 



[00338] As an over-determined linear system, 



[00339] 
[00340] 



where 
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A 2 = 



10 0 0 
0 10 0 
0 0 10 

1111 



v, = 



, b 7 = 



{ X SSR X tgt ) 

{y S sR-y,J 

{ Z SSR ~ Ztgt ) 



_ 2 

sro 



[00342] 



As a least squares problem, the function to be minimized is 



[00343] 



LS = [h 2 - 4 v 2 f {h 2 - ^ v 2 ) 



[00344] where the covariance matrix Hi of error vector ev 2 = AjV 2 —b 2 is 
approximated by 



[00345] 



H 2 = 4C 2 F,C 2 with 



[00346] 



C, = 



X SSR X lgt 



0 
0 

0 



0 0 0 

y SS R-y, g , o o 

o y S sR-y, g < o 

0 0 sro 



[00347] and 

[00348] F l =(A 1 Hj" , A 1 )" 1 . 

[00349] Thus, 

[00350] 

v 2 =(A 2 r // 2 - | A 2 )"'(A 2 7 "i/- 1 K 

=(a[(c 2 (a tfr'Ar^r^ ) ' {A[(c 2 (A//r'Arc 2 r^ 2 
= (a[ (c- 1 (a, //,-' a, ]c 2 -' K )"' • (a[ (q- 1 (a # a, Jc- 1 )K 
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[00351] Once v 2 is computed, the refined solution to the object position is 
obtained: 



[00352] 



X tgt ~ X SSR - V^l" 
Z tgt ~ Z SSR - 



[00353] There are eight possible solutions, and the one that is closest to the coarse 
solution [x tgt y ? f is selected as the object position. 

[00354] The functional block diagram of the RTOA computation according to 
some embodiments is shown in Figure 22. The steps of the RTOA computation can be 
summarized as follows. 

[00355] After starting the computation at 2710, the position of the receive sensors, 
the time of arrival of the signal at the sensors, the position of the SSR radar, and the time 
of transmission of the interrogator signal are acquired as indicated at 2715. As indicated 
at 2720, a coarse position of the object is computed by solving 



[00356] 



v, =(A 1 r P' I A I )" I A 1 r p- , -fe 1 . 



[00357] At 2725, the approximated covariance matrix Hi is computed from 



[00358] 



H x =c 2 C x PC x . 



[00359] At 2730, the coarse solution is refined by solving 



[00360] 



v x ^(A x T H- x A x )- X A x T H;^b x . 



[00361] At 2735, all the possible refined solutions of the object position are then 
computed by solving 



[00362] 



V 2 = \Ai [L 2 -[AiM.'A, fj 2 'fa) • \Ai [C 2 [A X H X A X jC 2 ' , 
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and, at 2740, using 



x tgi ~ x ssr — V^i" 

y, g , = y S sR±^- 



Z tgi ~ Z SSR 



[00365] At 2745, the refined solutions are compared with the coarse solution, and 
the one that is closest to the coarse solution is selected as the computed object position. 
At 2750 the computation ends. 

[00366] Proceeding similarly to the TOA and CH TDOA methods above, the 
RTOA computation my be performed for a 2D case A Monte-Carlo, or other numerical 
approximation, approach is used so that the time of arrival data and the time of transmit 
of the interrogation signal have added Gaussian noise error: 



[00367] 



t in =t_0 in +N{<r t ) 



[00368] 



[00369] 



where 



t_0 in = Actual time of arrival 

N(o t )= Random Gaussian error of variance a] 



[00370] After multiple iterations, the RMS error is computed for each computation 
and then compared. 

[00371] The TOA, CH TDOA and RTOA computations are applied to a 2-D case 
with three sensors. The sensors are positioned in units of miles at 



[00372] 



P Sl = 



15 
10 



,Ps 7 = 



15 
10 



,Ps, = 



-15 
-10 



[00373] 



The SSR is positioned at 
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[00374] Ps SSR = 



[00375] A grid covering the ±20 mile by ±20 mile region with 101 grid points 
along each side is used as object positions. For each grid node, the three computations 
are applied with 500 iterations to generate a set of error data so that the RMS error can be 
computed. The added Gaussian errors to the time of arrival data have the variance of 



[00376] 



[00377] In Figure 23, the resulting contours of the RMS errors for the three 
multilateration computations are shown. As shown, both the TOA and the TDOA 
computations have the same RMS errors, which are characterized by a region of very 
high errors behind the sensors. It is also clear that the RTOA computation gives much 
lower RMS error values, which implies greater accuracy. 

[00378] The three multilateration computations are applied to a 2-D case with four 
sensors. The sensors are positioned in units of miles at 



[00379] 



15 
10 



,Ps 2 = 



15 
10 



,Ps 3 = 



15 
10 



> 1 J 4 



15 
-10 



[00380] 



The SSR is positioned at 



[00381] 



Pc - 



[00382] The same grid as described above is also used in this case, and the added 
Gaussian errors are set to be the same. 



[00383] In Figure 24, the resulting contours of the RMS errors for the three 
multilateration computations are shown. As shown, the TDOA computation is more 
accurate compared to the TOA computation in most areas except along the vertical and 
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horizontal in the middle where the RMS errors are very large. This is likely due to the 
geometry of the set up in that along those two lines the matrix of the linear system is 
nearly singular. Similar to the previous case, the RTOA computation gives much lower 
RMS error values, which implies greater accuracy. 

[00384] The three multilateration computations are applied to a 3-D case with four 
sensors. The sensors are positioned in units of miles at 



[00385] 



Ps x = 



"15" 




-15" 




"-15" 




15" 


10 


,Ps 2 = 


10 


,Ps 3 = 


-10 


,Ps 4 = 


-10 


0 




0.1 




0.2 




0.3 



[00386] 



The SSR is positioned at 



[00387] 



P S SSR ~ 



[00388] A grid covering the ±20 mile by ±20 mile region with 101 grid points 
along the x- and y-axis positioned at the z-axis height of 10 miles is used as object 
positions; and for each grid node, the three computations are applied with 500 iterations 
to generate a set of error data so that the RMS error can be computed. The added 
Gaussian errors to the time of arrival data have the variance of 



[00389] 



(10ft 

I c J 



[00390] In Figure 25, the resulting contours of the RMS errors for the three 
multilateration computations are shown. As shown, both the TOA and the TDOA 
computations have the same RMS errors. It is also clear as before that the RTOA 
computation gives much lower RMS error values, which implies greater accuracy. 



r 
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[00391] The RTOA computation appears to work better than the previously 
discussed TOA and TDOA computation in the test cases that are studied here. Adding 
the time of transmission of the interrogator signal from the SSR appears to greatly 
increase the accuracy of the new multilateration scheme. On the other hand, it is not 
always clear how to obtain to for some cases. One possible solution is if the return from 
the transponder also includes information about to, then the RTOA computation could 
work well. 

The invention now being fully described, it will be apparent to one of ordinary 
skill in the art that many changes and modifications can be made thereto without 
departing from the spirit or scope of the invention as set forth herein. The foregoing 
describes the preferred embodiments of the present invention along with a number of 
possible alternatives. These embodiments, however, are merely for example and the 
invention is not restricted thereto. It will be recognized that various materials and 
modifications may be employed without departing from the invention described above, 
the scope of which is set forth in the following claims. 
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